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Abstract.  A  method  of  estimating  the  mass,  the  location  of  center  of  mass,  and 
the  moments  of  inertia  of  each  rigid  body  link  of  a  robot  during  general  manip¬ 
ulator  movement  is  presented.  The  algorithm  is  derived  from  the  Newton-Euler 
equations,  and  uses  measurements  of  the  joint  torques  as  well  as  the  measurement 
and  calculation  of  the  kinematics  of  the  manipulator  while  it  is  moving.  The  iden¬ 
tification  equations  are  linear  in  the  desired  unknown  parameters,  and  a  modified 
least  squares  algorithm  is  used  to  obtain  estimates  of  these  parameters.  Some  of  the 
jt^rameters,  J^owever.  are  not  identifiable  due  to  the  restricted  motion  of  proximal 
J infra aifd  (jiejjlack  of  full  force/torque  sensing.  The  algorithm  was  implemented  on 

Direct  Drive  Arm.  A  good  match  was  obtained  between  joint 
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Abstract.  A  method  of  estimating  the  mass,  the  location  of  center  of  mass,  and 
the  moments  of  inertia  of  each  rigid  body  link  of  a  robot  during  general  manip¬ 
ulator  movement  is  presented.  The  algorithm  is  derived  from  the  Newton-Euler 
equations,  and  uses  measurements  of  the  joint  torques  as  well  as  the  measurement 
and  calculation  of  the  kinematics  of  the  manipulator  while  it  is  moving.  The  iden¬ 
tification  equations  are  linear  in  the  desired  unknown  parameters,  and  a  modified 
least  squares  algorithm  is  used  to  obtain  estimates  of  these  parameters.  Some  of  the 
parameters,  however,  are  not  identifiable  due  to  the  restricted  motion  of  proximal 
links  and  the  lack  of  full  force/torque  sensing.  The  algorithm  was  implemented  on 
the  MIT  Serial  Link  Direct  Drive  Arm.  A  good  match  was  obtained  between  joint 
torques  predicted  from  the  estimated  parameters  and  the  joint  torques  computed 
from  motor  currents. 
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1  Introduction 


This  paper  presents  a  method  of  estimating  all  of  the  inertial  parameters,  the 
mass,  the  center  of  mass,  and  the  moments  of  inertia  of  each  rigid  body  link  of  a 
robot  manipulator  using  joint  torque  sensing.  Determining  these  parameters  from 
measurements  or  computer  models  is  generally  difficult  and  involves  some  approxi¬ 
mations  to  handle  the  complex  shapes  of  the  arm  components.  Typically,  even  the 
manufacturers  of  manipulators  do  not  know  accurate  values  of  these  parameters. 

The  degree  of  uncertainty  in  inertial  parameters  is  an  important  factor  in  judg¬ 
ing  the  robustness  of  model-based  control  strategies.  A  common  objection  to  the 
computed  torque  methods,  which  involve  full  dynamics  computation  (e.g.,  Luh, 
Walker,  and  Paul,  1980),  is  their  sensitivity  to  modelling  errors,  and  a  variety  of 
alternative  robust  controllers  have  been  suggested  (Samson,  1983;  Slotine,  1984; 
Spong,  Thorp,  and  Kleinwaks;  1984,  Gilbert  and  Ha,  1984).  Typically  these  robust 
controllers  express  modelling  errors  as  a  differential  inertia  matrix  and  coriolis  and 
gravity  vectors,  but  in  so  doing,  no  rational  basis  is  provided  for  the  source  of  er¬ 
rors  or  the  bounds  on  errors.  The  error  matrices  and  vectors  combine  kinematic 
and  dynamic  parameter  errors,  but  kinematic  calibration  is  sufficiently  developed 
so  that  very  little  error  can  be  expected  in  the  kinematic  parameters  (Whitney, 
Lozinski,  and  Rourke  ,  1984) . 

One  aim  of  this  work  is  to  place  similar  bounds  on  inertial  parameter  errors  by 
explicitly  identifying  the  inertial  parameters  of  each  link  that  go  into  the  making  of 
the  inertia  matrix  and  coriolis  and  gravity  vectors.  Our  work  in  load  identification 
(Atkeson,  An,  and  Hollerbach,  1985)  suggests,  for  example,  that  mass  can  be  accu¬ 
rately  identified  to  within  1%.  Therefore,  an  assumption  of  50%  error  in  link  mass 
in  verifying  a  robust  control  formulation  (Spong,  Thorp,  and  Kleinwaks,  1984)  is  an 
unreasonable  basis  for  argument.  Slotine  (1984)  suggests  that  errors  of  only  a  few 
percent  in  inertial  parameters  make  his  robust  controller  superior  to  the  computed 
torque  method,  but  it  may  well  be  that  these  parameters  can  be  identified  more 
accurately  than  his  assumptions. 

As  an  alternative  approach  we  propose  estimating  the  inertial  parameters  on  the 
basis  of  direct  dynamic  measurements.  The  same  algorithms  used  to  identify  load 
inertial  parameters  (Atkeson,  An,  and  Hollerbach,  1985)  can  be  modified  to  find 
link  inertial  parameters  of  a  robot  arm  made  up  of  rigid  parts.  The  Newt.on-Euler 
dynamic  equations  are  used  to  express  the  measured  forces  and  torques  at  each 
joint  in  terms  of  the  product  of  the  measured  movements  of  the  rigid  body  links 
and  the  unknown  link  inertial  parameters.  These  equations  are  linear  in  the  inertial 
parameters.  However,  unlike  load  estimation,  the  only  sensing  is  one  component 
of  joint  torque,  inferred  from  motor  current.  Coupled  with  restricted  movement 
near  the  base,  it  is,  therefore,  not  possible  to  find  all  the  inertial  parameters  of  the 


proximal  links.  As  will  be  seen,  these  missing  parameters  have  no  effect  on  the 
control  of  the  arm. 

In  this  paper,  manipulators  with  only  revolute  joints  are  discussed  since  handling 
prismatic  joints  requires  only  trivial  modifications  to  the  algorithm.  The  proposed 
algorithm  was  verified  by  implementation  on  the  MIT  Serial  Link  Direct  Drive  Arm. 

I. 1  Previous  Work 

Mayeda,  Osuka,  and  Kangawa  (1984)  required  three  sets  of  special  test  motions  to 
estimate  the  coefficients  of  a  closed-form  Lagrangian  dynamics  formulation.  The  10 
inertial  parameters  of  each  link  are  lumped  into  these  numerous  coefficients,  which 
are  redundant  and  susceptible  to  numerical  problems  in  estimation.  On  the  other 
hand,  every  coefficient  is  identifiable  since  these  coefficients  represent  the  actual 
degrees  of  freedom  of  the  robot.  By  sensing  torque  from  only  one  joint  at  a  time, 
their  algorithm  is  more  susceptible  to  noise  from  transmission  of  dynamic  effects  of 
distant  links  to  the  proximal  measuring  joints.  For  efficient  dynamics  computation, 
the  recursive  dynamics  algorithms  require  the  link  parameters  explicitly.  Though 
recoverable  from  the  Lagrangian  coefficients,  it  is  better  to  estimate  the  inertial 
parameters  directly.  Though  this  algorithm  was  implemented  on  a  PUMA  robot, 
it  is  difficult  to  interpret  the  results  because  of  dominance  of  the  dynamics  by  the 
rotor  inertia  and  friction. 

Mukerjee  (1985)  directly  applied  his  load  identification  method  to  link  identi¬ 
fication,  by  requiring  full  force-torque  sensing  at  each  joint.  Instrumenting  each 
robot  link  with  full  force-torque  sensing  seems  impractical,  and  is  actually  unnec¬ 
essary  given  joint  torque  sensing  about  the  rotation  axis.  Partially  as  a  result,  he 
does  not  address  the  issue  of  unidentifiability  of  some  inertial  parameters.  Also,  he 
did  not  verify  his  algorithm  by  simulation  or  by  implementation. 

Olsen  and  Bekey  (1985)  presented  a  link  identification  procedure  using  joint 
torque  sensing  and  special  test  motions  with  single  joints.  The  unidentifiability 
of  certain  inertial  parameters  was  not  resolved,  and  the  least  squares  estimation 
procedure  written  as  a  generalized  inverse  would  fail  because  of  linear  dependence  of 
some  of  the  inertial  parameters.  Again,  their  procedure  was  not  tested  by  simulation 
or  by  actual  implementation  on  a  robot  arm. 

Neuman  and  Khosia  (1985)  developed  a  hybrid  estimation  procedure  combining 
a  Newton-Euler  and  a  Lagrange-Euler  formulation  of  dynamics.  Simulation  results 
for  a  three  degree-of-freedom  cylindrical  robot  were  presented,  and  the  unidentifi¬ 
ability  of  certain  inertial  components  was  addressed.  For  some  reason  they  state 
link  mass  must  be  known  for  a  linear  estimation  procedure,  but  such  a  restriction 
does  not  exist  with  our  method.  Though  planning  to  work  with  the  CMU  DDArm 

II,  they  have  not  yet  presented  experimental  results. 
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Figure  1:  Coordinate  origins  and  location  vectors  for  link  identification. 

2  ESTIMATION  PROCEDURE 

2.1  Formulation  of  Newton-Euler  Equations 

In  our  work  in  load  identification  (Atkeson,  An,  and  Hollerbach,  1985),  the  Newton- 
Euler  equations  for  a  rigid  body  load  were  formulated  to  be  linear  in  the  unknown 
inertial  parameters.  Then  simple  linear  least  squares  method  was  used  to  estimate 
those  parameters.  By  treating  each  link  of  a  manipulator  as  a  load,  this  formulation 
can  be  extended  to  the  link  estimation  problem.  The  differences  in  the  equations 
are  that  only  one  component  of  force  or  torque  is  sensed  and  that  the  forces  and 
torques  from  distal  links  are  summed  and  transmitted  to  the  proximal  joints. 

Consider  a  manipulator  with  n  joints  (Figure  1).  Each  link  i  has  its  own  local 
coordinate  system  Pi  fixed  in  the  link  with  its  origin  at  joint  t.  The  joint  f<~>rce  and 
torque  due  to  the  movement  of  its  own  link  can  be  expressed  by  simply  treating  the 
link  as  a  load  and  applying  the  previously  developed  equations  for  load  identification 
(Atkeson,  An,  and  Hollerbach,  1985): 


n„ 

P.--g  [£%x] +  [w<x][w,-x]  0 

.  0  [(g-P.)x]  [««i]  +  [w<x  ][•«,- 


or  more  compactly, 


w,<  =  Ai<f>i 


where  wtJ-  is  the  wrench  (vector  of  forces  and  torques)  at  joint  i  due  to  movement  of 
link  j  alone.  A,-  is  the  kinematic  matrix  that  describes  the  motion  of  link  i  and  <j>t  is 
the  vector  of  unknown  link  inertial  parameters.  All  of  the  quantities  are  expressed 
in  the  local  joint  i  coordinate  system.  The  formulation  of  the  above  Newton-Euler 
equations  were  already  presented  in  the  load  identification  paper  (Atkeson,  An,  and 
Hollerbach) ,  and  are  summarized  in  the  Appendix  of  this  paper  for  a  reference. 

The  total  wrench  w,  at  joint  i  is  the  sum  of  the  wrenches  w,;  for  all  links  j 
distal  to  joint  t: 

N 

w.  =  H  ”i,  (2) 

j=* 

Each  wrench  wtJ  at  joint  t  is  determined  by  transmitting  the  distal  wrench  wj;- 
across  intermediate  joints.  This  is  a  function  of  the  geometry  of  the  linkage  only. 
The  forces  and  torques  at  neighboring  joints  are  related  by 


f|,i+l 

n,.,+i 


K-i  0  £+i,i+i 

3,x]  •  R,  R,  ni+i,l+i 


or  more  compactly 


where 


wv.,+1  =  T,  w,+  li, 


R,=  the  rotation  matrix  rotating  the  link  i  +  1  coordinate  system  to  the  link  i 
coordinate  system, 

s,=  a  vector  from  the  origin  of  the  link  i  coordinate  system  to  the  link  i  +  1  co¬ 
ordinate  system,  and 


T,=  a  wrench  transmission  matrix. 


To  obtain  the  forces  and  torques  at  the  iih  joint  due  to  the  movements  of  the 
jth  link,  these  matrices  can  be  cascaded: 


wij — TjT,-+i 

-U  n4>j 


TyW; 


33 


(5) 


where  U,y  =  T,Ti+1  •  •  •  TyA,-  and  U„  =  A*.  A  simple  matrix  expression  for  a  serial 
kinematic  chain  (in  this  case  a  six  joint  arm)  can  be  derived  from  (2)  and  (5): 


Wl 

Uu 

U12 

u13 

U14 

U15 

u 

w2 

0 

U22 

U28 

u24 

U25 

u: 

W3 

0 

0 

U33 

U34 

U35 

u 

w4 

0 

0 

0 

U44 

u45 

u. 

WB 

0 

0 

0 

0 

Uss 

U, 

W6 

0 

0 

0 

0 

0 

u, 

16 

26 

36 

46 

56 

66 


<f>  1 

<p2 

4*3 

^6 

(6) 


This  equation  is  linear  in  the  unknown  parameters,  but  the  left  side  is  composed 
of  a  full  force-torque  vector  at  each  joint.  Since  only  the  torque  about  the  joint 
axis  can  usually  be  measured,  each  joint  wrench  must  be  projected  onto  the  joint 
rotation  axis  (typically  [0,0,1]  in  internal  coordinates),  reducing  (6)  to 


r—  Kip  (7) 

where  =  [0,0, 0,0,0,  l]w,  is  the  joint  torque  of  the  itk  link,  ip  -  <j>« 

and  Kjj  =  [0,0, 0,0, 0,1]  •  Ujy  when  the  corresponding  entry  in  (6)  is  nonzero.  For 
an  n-link  manipulator,  r  is  a  n  x  1  vector,  ip  is  a  lOn  x  1  vector,  and  K  is  a  n  x  1  On 
matrix. 


2.2  Estimating  the  Link  Parameters 

Equation  (7)  represents  the  dynamics  of  the  manipulator  for  one  sample  point.  For 
extra  data,  (7)  is  augmented  as: 


■  m 

'  hi)  ' 

K  = 

r  = 

N  —  number  of  data  points 

.  *(JV)  . 

.  r (N)  . 

Unfortunately,  one  cannot  apply  simple  least  squares  estimate: 

=  (KrK)~,Krr  (8) 


because  KTK  is  not  invertible  due  to  loss  of  rank  from  restricted  degrees  of  freedom 
at  the  proximal  links  and  the  lack  of  full  force-torque  sensing. 

There  are  several  ways  to  resolve  this  problem.  One  way  to  resolve  this  problem 
is  to  use  the  pseudo  inverse  to  get  a  solution  $  to  r  =  Ki/>.  But  since  K  is  a 
potentially  large  nN  x  lOn  matrix,  the  pseudo-inverse  is  computationally  inefficient. 
Another  simple  method  similar  to  the  pseudo  inverse  is  to  use  ridge  regression 
(Marquardt  and  Snee,  1975).  Ridge  regression  makes  KTK  invertible  by  adding  a 
small  number  to  the  diagonal  elements: 

V'  =  (KrK  +  dI10n)-1KTr  (9) 

The  estimates  are  nearly  optimal  if  d  <<  X  min(KTK ),  where  Am,„  is  the  smallest 
non-zero  eigenvalue  of  KTK.  Other  methods  of  solution,  fundamentally  different 
from  the  above  two,  are  presented  in  the  discussion  section. 

3  Experimental  Results 

Link  estimation  was  implemented  on  the  MIT  Serial  Link  Direct  Drive  Arm  (Figure 
2),  a  three  link  serial  manipulator  with  no  transmission  mechanism  between  the 
motors  and  the  links.  The  ideal  rigid  body  dynamics  is  a  good  model  for  this  arm, 
uncomplicated  by  joint  friction  or  backlash  typical  of  other  manipulators.  Hence  the 
fidelity  of  this  manipulator’s  dynamic  model  suits  estimation  well.  The  coordinate 
system  for  this  arm  is  defined  in  Figure  3.  A  set  of  inertial  parameters  is  available 
for  the  arm  (Table  1),  determined  by  modeling  with  a  CAD /CAM  database  (Lee, 
1983).  These  values  can  serve  as  a  point  of  comparison  for  our  method,  but  they 
may  not  be  accurate  because  of  modeling  errors. 

The  motors  are  rated  at  660  Nm  peak  torque  for  joint  1  and  230  Nm  for  joints 
2  and  3  (Asada  and  Youcef-Toumi,  1984).  Joint  1  is  presently  capable  of  an  an¬ 
gular  acceleration  of  1150  deg/ sec2,  joints  2  and  3  in  excess  of  6000  deg/sec2.  In 
comparision,  joint  1  of  the  PUMA  600  has  a  peak  acceleration  of  130  deg /sec2  and 
joint  4  at  the  wrist  260  deg /sec2.  Joint  position  is  measured  by  a  resolver  and  joint 
velocity  by  a  tachometer.  The  tachometer  output  is  of  high  quality  and  leads  to 
good  acceleration  estimates  after  differentiation.  The  accuracy  of  the  acceleration 
estimates  plus  high  angular  accelerations  greatly  improves  inertia  estimation. 

The  joint  torques  are  computed  by  measuring  the  currents  of  the  3  phase  wind¬ 
ings  of  each  motor  (Asada,  Youcef-Toumi,  and  Lim,  1984).  For  the  three  phase 
brushless  permanent  magnet  motors  of  the  direct  drive  arm,  the  output  torque  is 
related  to  the  currents  in  the  windings  by: 

r  =  KY(/0sin  9  +  7i,sin(0  -f  120)  +  Ics\n(9  +  240))  (10) 
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Figure  3:  The  link  coordinate  system. 


The  torque  constant  Kt  for  each  motor  is  calibrated  statically  by  measuring  the 
force  produced  by  the  motor  torque  at  the  end  of  a  known  lever  arm.  The  force 
is  measured  using  a  BarryWright  Company  Astek  FS6-10A-200  6-axis  force/torque 
sensor.  Asada,  Youcef-Toumi,  and  Lim  have  found  that  for  a  motor  similar  to 
the  motors  of  our  manipulator,  the  torque  versus  current  relationship  was  non¬ 
linear,  especially  for  small  magnitudes  of  torques,  and  also  varied  as  a  function  of 
the  rotor  position.  However,  for  the  results  presented  in  this  paper,  the  nonlinear 
effects  were  ignored  since  substantial  portions  of  the  movements  in  the  experiments 
required  large  magnitudes  of  torques.  Since  the  least  squares  algorithm  minimizes 
the  square  of  the  error,  torque  errors  for  torques  of  small  magnitudes  do  not  affect 
the  estimates  very  much. 

For  the  estimation  results  presented,  600  data  points  were  sampled  while  the 
manipulator  was  executing  3  sets  of  fifth  order  polynomial  trajectories  in  joint 
space.  The  specifications  of  the  trajectories  were: 

1.  (330,  289.1,  230)  to  (80,  39.1,  -10)  degrees  in  1.3s, 

2.  (330,  269.1,  -30)  to  (80,  19.1,  220)  degrees  in  1.3s, 

3.  (80,  269.1,  -30)  to  (330,  19.1,  220)  degrees  in  1.3s, 

Since  KrK  in  (9)  is  singular,  estimates  for  the  30  unknowns  are  computed  by  adding 
a  small  number  ( d  =  10.0  <<  A  m,„(KrK)  =  3395.0)  to  the  diagonal  elements  of 


Parameters 

Link  1 

Link  2 

Link  3 

m(Kg) 

67.13 

53.01 

19.67 

mcx(Kg  ■  m) 

0.0 

0.0 

0.3108 

mcv 

2.432 

3.4081 

0.0 

mcz 

35.8257 

16.6505 

0.3268 

Izx[Kg  •  m2) 

23.1568 

7.9088 

0.1825 

hv 

0.0 

0.0 

0.0 

-0.3145 

0.0 

-0.0166 

IyV 

20.4472 

7.6766 

0.4560 

ly* 

-1.2948 

-1.5036 

0.0 

L, 

0.7418 

0.6807 

0.3900 

Table  1:  CAD-modeled  inertial  parameters. 


KtK. 

Typical  results,  obtained  using  ridge  regression  method,  are  shown  in  Table  2. 
Parameters  that  cannot  be  identified  because  of  constrained  motion  near  the  base 
are  denoted  by  0.0*.  The  first  nine  parameters  of  the  first  link  are  not  identifiable 
because  this  link  has  only  one  degree  of  freedom  about  its  z  axis.  These  nine 
parameters  do  not  matter  at  all  for  the  movement  of  the  manipulator  and  thus  can 
be  arbitrarily  set  to  0.0. 

Other  parameters  marked  by  (f)  can  only  be  identified  in  linear  combinations, 
indicated  explicitly  in  Table  3.  The  ridge  regression  automatically  resolves  the 
linear  combinations  in  a  least  squares  sense.  It  can  be  seen  that  the  estimated  sums 
roughly  match  the  corresponding  sums  inferred  from  the  CAD-modeled  parameters, 
but  the  sizeable  discrepancy  indicates  that  one  parameter  set  may  be  more  accurate 
than  the  other. 

To  verify  the  accuracy  of  the  estimated  and  the  modeled  parameters,  the  mea¬ 
sured  joint  torques  are  compared  to  the  torques  computed  from  the  above  two 
sets  of  parameters  using  the  measured  joint  kinematic  data.  As  shown  in  Figure 
4,  the  estimated  torques  match  the  measured  torques  very  closely.  The  torques 
computed  from  the  CAD/CAM  modeled  parameters  do  not  match  the  measured 
torques  as  closely.  This  comparison  verifies  qualitatively  that  for  control  purposes 
the  estimated  parameters  are  in  fact  more  accurate  than  the  modeled  parameters. 


Parameters 

Link  1 

Link  2 

m(Kg) 

0.0* 

0.0* 

mcx(Kg  •  m) 

0.0* 

-0.1591 

mcv 

0.0* 

0.6776f 

me. 

0.0* 

0.0* 

I*z(Kg  •  rri1) 

« 

o 

o 

4.1562f 

u 

0.0* 

0.3894 

0.0* 

0.0118 

lyv 

0.0* 

5.2129f 

Iyn 

0.0* 

-0.6050f 

/« 

9.33598f 

-0.8194f 

Link  3 


92 

46 

03 


-1.0087f 


7 

2 

1 


1.8967f 

-0.0160 

0.3568 


Table  2:  Estimated  inertial  parameters. 


4  Discussion 


Good  estimates  of  the  link  inertial  parameters  were  obtained,  as  determined  from 
the  match  of  predicted  torques  to  measured  torques.  The  potential  advantage 
of  this  movement-based  estimation  procedure  for  increased  accuracy  as  well  as 
convenience  was  demonstrated  by  the  less  accurately  predicted  torques  based  on 
the  CAD-modeled  inertial  parameters. 

There  are  three  groups  of  inertial  parameters:  fully  identifiable,  completely 
unidentifiable,  and  identifiable  in  linear  combinations.  Membership  of  a  parameter 
in  a  group  depends  on  the  manipulator’s  particular  geometry.  Some  link  inertial 
parameters  are  unidentifiable  because  of  restricted  motion  near  the  base  and  the 
lack  of  full  force-torque  sensing  at  each  joint.  For  the  first  link,  rotation  is  only 
possible  about  its  z  axis.  Suppose  full  force-torque  sensing  is  available  at  joint  1. 
It  can  be  seen  from  (1)  that  /«,,  JXWl,  and  /Vtfl  are  unidentifiable  because  they  have 
no  effect  on  joint  torque.  Since  the  gravity  vector  is  parallel  to  the  z  axis,  ctI  is 
also  unidentifiable.  If  it  is  now  supposed  that  only  torque  about  the  z  axis  can  be 
sensed,  then  all  inertial  parameters  for  link  1  become  unidentifiable  except  /«, . 

In  a  multi-link  robot  a  new  phenomenon  arises.  Some  parameters  can  only  be 
identified  in  linear  combinations,  because  proximal  joints  must  provide  the  torque 
sensing  to  identify  fully  the  parameters  of  each  link.  Certain  parameters  from 
distal  links  are  carried  down  to  proximal  links  until  a  link  appears  with  a  rotation 
axis  oriented  appropriately  for  completing  the  identification.  In  between,  these 
parameters  appear  in  linear  combinations  with  other  parameters.  This  partial 
identifiability  and  the  difficulty  of  analysis  become  worse  as  the  number  of  links  are 
increased. 

The  ridge  regression  automatically  resolves  the  linear  combinations  in  a  least 
squares  sense,  which  make  these  inertial  parameters  appear  superficially  different 
from  those  derived  by  CAD  modeling.  An  alternative  method  is  generation  and 
examination  of  the  closed-form  dynamics,  which  is  a  complex  procedure  for  more 
than  two  degrees  of  freedom. 

A  second  alternative  is  a  numerical  analysis  via  singular  value  decomposition  of 
K  in  (8),  yielding  (Golub  and  Van  Loan,  1983) 

K  =  UEVr 

where  E  =  diag{oj}  and  U  and  Vr  are  orthogonal  matrices.  For  each  column 
of  V  there  corresponds  a  singular  value  Oi  which  if  not  zero  indicates  that  linear 
combination  of  parameters,  vf  V,  is  identifiable.  Since  K  is  a  function  only  of  the 
geometry  of  the  arm  and  the  commanded  movement,  it  can  be  generated  exactly 
by  simulation  rather  than  by  actually  moving  the  real  arm  and  recording  data  with 
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inevitable  noise. 

The  above  two  rocedures  isolate  several  sets  of  parameters  whose  linear  combi¬ 
nations  within  each  set  are  identifiable.  Then  we  can  arbirtrarily  set  all  but  one 
of  the  parameters  of  each  set  to  zero  and  apply  the  estimation  algorithm  for  the 
reduced  set  of  fully  identifiable  parameters.  As  shown  in  Table  2,  for  our  3  link 
manipulator,  these  two  procedures  result  in  grouping  the  30  inertial  parameters 
into  the  following  categories: 

1.  fully  identifiable:  m3cIS,  m3cys,  Ivn,  IZZs,  m2cZj,  Ixyi,  Ixl3 

2.  completely  unidentifiable:  m2,  m2c,a,  mi,  micXl ,  miCVl,  mictl,  IXXi,  IXVl ,  IXZl, 

lyyii  lyzi 

3.  identifiable  in  linear  combinations:  m3,  m3c„  JIl3,  Jyy3 ,  m2cya,  1XX3 ,  Jyy2,  Jy*2 

The  completely  unidentifiable  parameters  can  be  arbitrary  set  to  zero.  For  the 
linear  combination  parameters,  the  combinations  of  these  parameters  that  can  be 
identified  together  are  shown  in  table  3.  To  obtain  a  particular  solution  for  these 
parameters,  one  can  set  m3,  msC,,,  Jz*3,  and  IZX3  to  zero.  Then,  the  remaining  6 
parameters  of  this  category  can  be  treated  as  fully  identifiable  parameters  along 
with  the  9  parameters  in  the  first  category.  Those  columns  of  K  which  correspond 
to  the  15  zeroed  parameters  are  taken  out,  reducing  KTK  to  a  15  x  15  full  rank 
matrix.  Now,  simple  least  squares  can  be  applied  to  estimate  the  15  identifiable 
parameters.  For  our  implementation  experiments,  the  results  of  this  method  agreed 
with  the  results  of  ridge  regression  presented  in  the  previous  section. 

Although  not  as  simple  as  the  ridge  regression  method,  these  methods  are  attrac¬ 
tive  since  it  allows  us  to  reformulate  the  dynamics  in  terms  of  only  the  identifiable 
parameters.  This  then  can  increase  the  efficiency  of  the  corresponding  inverse  dy¬ 
namics  computation  for  controller  implementations  (Hollerbach  and  Sahar,  1983). 
We  are  still  investigating  these  issues  with  eventual  goals  of  studying  the  effec¬ 
tiveness  of  different  control  algorithms  using  the  estimated  dynamic  model  and 
analyzing  their  robustness  with  modelling  errors. 
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APPENDIX 

Beginning  with  an  n-joint  manipulator,  we  assume  each  link  t  has  a  local  coordinate 
system  P,  with  origin  fixed  at  joint  t;  the  vector  p,-  locates  P,-  with  respect  to  a 
global  coordinate  system  O  (Figure  1).  At  the  center  of  mass,  a  coordinate  system 
Q,is  aligned  with  the  principle  axes  of  inertia.  The  center  of  mass  is  located  with 
respect  to  Pf-  by  the  vector  ct-  and  with  respect  to  the  global  origin  O  by  q,. 

The  inertial  parameters  of  mass,  center  of  mass,  and  moment  of  inertia  are 
related  to  the  motion  of  link  i  by  the  Newton-Euler  equations: 

A  =  fa  +  rriig  =  mAi  (11) 


„n,  =  nti  -  c,  x  f,,  =  ,1 iiJi  +  w<  x  (,!,«,) 


where 


4ft-  =  the  net  force  acting  on  link  t, 

4n,-  =  the  net  torque  about  the  center  of  mass  of  link  i, 
f ij  =  the  force  at  joint  i  due  to  motion  of  link  j  alone, 
ny  =  the  torque  at  joint  i  due  to  motion  of  link  j  alone, 
m,  =  the  mass  of  link  t, 

,1,  =  the  moment  of  inertia  about  the  center  of  mass, 
w,  =  the  angular  velocity  vector,  and 
g  =  the  gravity  vector  (g  =  [0,0,— 9.8  m/sec*]). 

Although  the  location  of  the  center  of  mass  and  hence  its  acceleration  q<  are 
unknown,  the  latter  is  related  to  the  acceleration  p,-  of  joint  i  by  (Symon,  1971): 

=  Pi  +  X  C,  +  Ui  x  (Wj  x  c<)  (13) 

Substituting  into  (11),  which  then  substitutes  into  (12), 

f»  =  m,  (p,  -  g)  +  Ui  x  m,c,  +  Ui  x  (w<  x  m,c<)  (14) 

=  (g  -  Pi)  *  mid  +  ,Ii«i  +  mcj  x  (^  x  c.)  ^ 

-t-WiX^IiW,)  +  m,c,  x  (w,  x  (w,  xcj)) 

Although  the  terms  c,-  x  (w<  x  c<)  and  d  x  (w,  x  (wj  x  c<))  are  qxiadratic  in  the 
unknown  location  of  the  center  of  mass  c<,  they  may  be  eliminated  by  expressing 


a  '•  .■> 
‘ 

y.s 
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the  moment  of  inertia  tensor  about  the  joint  t  origin  PI,  instead  of  about  the  center 
of  mass  ,1,-.  By  the  parallel  axis  theorem  (Symon,  1971), 

pIi  =  „I ,  +  m,-[(cfc,-)l  -  (c.cf)]  (16) 

where  1  is  the  3  dimensional  identity  matrix.  Rewriting  (15)  and  using  (16), 

n„  =  (g  -  P.)  x  m,c,+,I,Wi  +  mj[(cfcj)l  -  (c,cf)]w,- 

x  (,I,Wi)+Wi  x  (m,[(cfc,)l  -  (c,cf)]w,)  (17) 

=  (g  -  P.)  x  rriiCi+pliVi  +  x  (PI ,«,) 

The  following  notation  aids  formulating  a  system  of  linear  equations  from  those 
above: 

0  -u„  Up  cx 

U  X  C  =  0Jt  0  —U)x  cv  =  «x  c 


0 

- 

-ux 

= 

(Jj, 

0 

—  Uy 

w* 

Uy 

ut 

0 

0 

w* 

0 

(jJy 

0 

0 

w. 

=  !•«] 


where 


■fix  Ixy  fj« 

I  =  I  =  IXy  lyy  lyz 

.  Izt  lyz  lit 


A  matrix  equation  can  then  be  written  from  (14)  and  (17): 


n„ 

Pi-g  [w,x]  +  [wiX][«,'X]  0 

.  0  [(g-Pi)x]  [•d/l]  4-  [^x][»t^f 


m, 

ro.Cz, 

m.ci/, 

ro,c2. 


